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© Hnrichtung zum Kompensleren des 8chwertaraftelnflusses auf eln etefctromotorisch hob- und 

senkbares Element elner Werfczeugmaschlne Oder eines Roboters und Verfahrsn zum Betrieb einer 
deraiilyeii Einrtcfitung. 



© Um bei hMngenden Achsen osier Werkzeugma- 
schine Oder aufetnander reitenden Achsen eines 
Roboters den Schwerkrafteinflufl zu eliminieren, wird 
bei geregeiten Antrieben etne SteuergrSfle (Ms) in 
den RegeJkrete (R,S) eingefOgt die dem Gewicbt- 
setnflufl entgegenwirkt Damrt kann eine hohe Dyna- 
mik der Qesamtanordnung erreicht werdsn. 
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Elntlchtuno zum &gmgfflglffl30 Sgfiwerkrafteinflu ssas auf In eiektromotorisch^ heb-und senkba- 
res Element einer Wertaeuomaschlna ody g^s Rgfry^r? HOfl Yjgftti&B SMffl 'nor derartinpn 

Elnrlchtuno 



Die Erfindung bezieht sich auf efne Einrlchtung 
zum Kompensieren des Schwerkrafteinfiusses auf 
ein eiektromotorisch heb-und senkbares Bement 
einer Werkzeugmaschine oder eines Roboters, 
wobei die FUhrungsgrdBe fQr die Bewegung des 
zugeordneten Antriebs auf diesen Ober mindestens 
elnen Regier so einwirkt daB als StellgrSfle ein 
dem Jewells einzustellenden Moment des Antriebs 
entsprechender Strom auslSsbar fst 

Bei hangenden Achsen einer Werkzeugma- 
schine sowie bei den aufeinander reitenden Achsen 
eines Roboters tritt das Problem auf, daB aufgrund 
des Schwerkrafteinfiusses die eiektromotorisch 
heb-und senkbaren Bemente im ungeregeiten Zu- 
stand in die Senkposifon sich bewegen. Bei han- 
delsQblichen Bnrichtungen wird deshalb beispiels- 
worse mit Fedem Oder hydraulischen Hilfskrelsen 
etn Schwerkraftausgleich angestrebt Dabel erweist 
es sich jedoch als ungQnstig, daB derartige Mittel 
zum Schwerkraftausgleich aufgrund threr bewegten 
Masse und/oder ihrer Federeigenschaft das Regel- 
verhaten der Gesamtanordnung hinslchtiich der er- 
reichbaren Dynamik verschlechterrt 

Aufgabe der Erfindung ist es, eine Bnrichtung 
der elngangs genannten Art so auszubilden, daB 
mit geringem technischen Aufwand ein Schwerkraf- 
tausgleich erreicbt wird, bet dem eine hohe Dyna- 
mik der Regelung mSglich 1st 

GemSB der Erfindung wird diese Aufgabe 
dadurch gel3st, daB der Stellgr6Be eine 
Steuergr5Be Qberlagerbar ist, die ein stQtzendes 
Gegenmoment zu dem durch die Schwerkraft auf 
das heb-und senkbare Element und dam it auf den 
Antrieb ausgeQbten Moment bikJet 

Die Erfindung bezterrt sich femer auf ein Ver- 
fahren zum Betrieb einer derartigen Bnrichtung. 
Dabei soil eine einfache Ermittlung der zu 
Qberlagemden SteuergrBfle erm6glicht werden. 

GemfiB der Erfindung wird diese Aufgabe 
dadurch geidst daB zunachst ohne SteuergrfiBe 
mit einem unkritisch eingestelrten Regier bei vor- 
gebbaren Lagen jeweils ein statischer Zustand ein- 
geregeit wird, daB die dabei resurtierende 
SteiigrdBe registriert wird, daB fQr jede dieser 
Lagen die jeweils registrierte SteilgrCBe als 
SteuergrdBe aufgeschaitet wird und daB daraufhin 
der Regier in seiner Bnsteilung optimiert wird. 

Die Optimierung kann beispieisweise gemSB 
der DE-Anmeldung P 34 27 127 erfolgen. 

Bei wegabhanglgem SchwerkrafteinfluB. wie er 
insbesondere beim Roboterbetrieb vorliegt ist eine 
vorteilhafte Ausbildung des Verfahrens dadurch ge- 
kennzeichnet, daB nach der Optimierung des Re- 



glers die Aufschaitung der SteuergrSBe 
zurQckgertommen wird. Die zwischenzettige Auf- 
schaitung der Steuergr5Be erleichtert dabei die Op- 
timierung des Reglers. 
5 Bn AusfQhrungsbeispiei der Erfindung ist in 
der Zeichnung dargestelit und wird im folgenden 
nSber erifiutert Dabei zeigen: 

Bg. 1 eine DWiche Mb*glichkeit der Schwer- 
kraftkompensation und 

10 Rg. 2 ein Blockschaitbild der Erfindung. 

In der Darsteilung gemfiB Fig.1 ist der vertikal 
gelagerte Tisch Tl einer der Obersichtiichkeit hai- 
ber nicht dargestelften Werkzeugmaschine, zJB. 
einer Hochgeschwindigkeitsfrase, gezeigt der von 

75 einer Spindel SP bewegt wird, die mit einem Motor 
M gekuppelt ist 

Die Steuerung des Motors M erfolgt anhand 
von Stellbefehlen einer Werkzeugma- 
schinensteuerung ST. Diese ist Ober 'ein 

20 MeBsystem MS Ober die jeweilige Lage des Tl- 
sches Tl informiert und ermittelt numerisch eine 
Solldrehzahl n^ fQr den Motor M. Die Solldrehzahl 
nsoo ist dabei FUhrungsgrSBe fQr einen Regier R, 
der im AusfQhrungsbeispiei als Pl-Regler ausgebtl- 

25 det ist Der Motor M ist mit einem Tachogenerator 
T verbunden, der die jeweilige Istdrehzahl n* auf 
den Regier R rOckfGhrt so daS aus der Regefeb-: 
weichung zwischen Solldrehzahl und istdreh- 
zahl n*der Regier R das jeweilige Sollmoment 

so M.oa als StedgrBBe in Form eines Stroms fQr den 
Motor M biidet Die gesamte Anordnung von Tisch 
Tl, MeBsystem MS, Spindel SP, Motor M und Ta- 
chogenerator T ist in der Darsteilung gestrichett zur 
Strecke S zusammengefaBt dargestelit 

ss Der Tisch Tl hat aufgrund seines Bgengewich- 
tes die Tendenz sich abzusenken. Dies fQhrt dazu, 
daB Ober die nicht hemmende Spindel SP auf dem 
Motor M ein Moment ausgeubt wird, das in der 
Darsteilung gemSB Fig.2 als Qewichtsmoment Mq 

40 bezeichnet wird. Bei der in Fig.1 dargestellten Bn- 
richtung wird dieses Qewichtsmoment M G dadurch 
eliminiert, daB der Tisch Tl mit einem Kolben K 
verbunden ist der in einem Zylinder Z ge fQhrt ist 
wobei der Kolben K mit HiRe eines von einer Pum- 

45 pe P erzeugten und Ober ein Ventil V einsteilbaren 
Oldruckes eine definierte Gegenkraft ausQbt Die 
Pumpe P wird dabei mit 6l einer Olwanne OE 
gespeist 
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Die Darstellung gem&A Rg.2 zdrgt ein Block- 
schaltbild der Erfindung, wobei von einer Etnrich- 
tung gemfifl Rg.1 ausgegangen wird, bei der aJlor- 
dings auf den hydraulischen Gewichtsausgleich 
verzfchtet ist Gleiche Bemente wetsen in Rg.2 
gtetehe Bezugszeichen wte in Rg.1 auf. 

In der Darstellung gemdfl Rg.2 ist fur die 
Strecke S deren Ersatzschattbtld gazeigt bei dem 
die elektrischen Bgenschaften durch sin PT1-QRed 
und die mechanischen Bgenschaften durch ein \- 
Qtied angegeben sind. 

ZunSchst sei noch einmal auf die Funktion der 
Bnrichtung gemftB Rg.1 verwtesen. Debel wird der 
Strecke S und damft dem PTi-GSed emgangssertig 
das Sollmoment in Form eines Stromes zu- 
gefOhrt, der Motor M erzeugt hieraus ein Antrieb- 
sanmoment M A , dieses wird vom Gewichtsmoment 
Mq Qbertagert und das resultferende Moment fOhrt 
zu etner Istdrehzahl n to . Dabei wird jedoch das 
Gewichtsmoment M 0 weitgehend eiiminiert 

Hier unterscheidet sich die Erfindung vom 
Stand der Technlk dadurch, dafl auf sine derartige 
Kompensation des Gewichtsmomentes Mq vOllig 
verzfchtet wird. Demzufofge wirkt die Oberlagerung 
von Arrtriebsmoment M A und Gewichtsmoment Mq 
auf das l-Gtied ein. Die erfindungsgem&fle Kom- 
pensation der Schwerkraftseinflusses erfotgt nun 
dadurch, dafl das Sollmoment M** des der Strecke 
vorgeschalteten Regiers R urn eine SteuergrOSe 
Ms so korrigJert wird. d&fi durch diese ein 
stQtzendes Gegenmoment zu dem durch die 
Scmverkraft auf das heb-und senkbare Element 
und damri auf den Antrieb. dJt. den Motor M. 
ausgeQbten Mofnontss gebikJet wird. Der Betrag 
und die Richtung dieser SteuergrSBe kann berecb- 
net oder gemessen werden und von einem demzu- 
fdge etnzusteilenden Geber G2 wird dann ein ents- 
prechendes Steuersjgnal ausgegeben. 

HHufig ist as jedoch der Fat), da* diese 
SteuergrOfle schwer bestimmbar ist insbesondere 
wenn diese SteuergrOfle wegabhangig verandertich 
ist Letzteres ist insbesondere bei aufeinander ret* 
tendon Achsen von Robotem der Fall. Daher wird 
zur Steuergrtiflebestimmung aus einer vorgegebe- 
nen Lage heraus, insbesondere bei der Erstinbe- 
triebnahme. gem&6 der Erfindung folgendes Ver- 
fahren angewendet 

Zunlchst wird bei nicht geschlossenem Regel- 
kreis durch LOsen von der Obersicrrtlichkert halber 
in der Darstellung gemSfl Rg.1 nicht gezeigten 
mechanischen Bremsen der Regelsinn der Anord- 
nung ermrttett, indem beispielsweise durch kurzsei- 
tiges Anregen der Strecke S mit Nennmoment das 
Vorzeichen der Streckenantwort in Form von Dreh% 
zahllstwerten ermitteit wird. 



Daraufhin wird der Regelkreis mit robusten 
Regelparametem geschiossen. Damit wird Qber 
den gesamten Variationsbereich der Strocken para- 
meter eine stabile, wenn auch nicht besonders 

5 dynamische Regelung ermOgficbt 

Wenn fQr die jeweilige Lage ein statischer Zu- 
stand sich eingestellt hat, wird, wie durch eine 
gestricheKe Wirklinie zwtschen Regler R und Geber 
G2 angedeutet die jeweilige StellgrOfle des 

to Regiers R vom Geber G2 registries Im fblgenden 
wird diese StellgrOfle M „„aJs SteuergrOfle M s auf 
die Strecke S aufgeschaltet. Daraufhin kann der 
Regler R in seiner Bnstellung so optimiert werden, 
wte dies beispieihaft in der eingangs genannten 

75 DE-Anmeldung beschrieben ist 

Wenn bei Robotem wfihrend des auf die Inbe- 
triabnahmephase folgenden eigentJichen Betrtebs 
der stOrende Schwerkrafteinflufl starken weg- 
abhangigen Schwankungen unteriiegt kann nach 

20 der Optfmierung des Regiers R die Aufschaltung 
der SteuergrOBe Mb wieder rQckg&ngig gemacht 
werden. Die Kompensation erfolgt daraufhin 
automatfsch durch den Regler R. Die zwi- 
schenzertlicbe Aufschaltung der SteuergrOfle Ms 

25 hat dann den Vorteil erbracht dafl wShrend der 
Inbetriebnahmephase durch die SteuergrOBe M 8 
der StOreinflufl des Gewichtsmoments Mq kompen- 
siert worden ist so dad die Streckenparameter fOr 
die Optfmierung eindeutig identrftziert werden kon- 

ao rttan, so dafl die Bnsteikmg des Regiers R erleich- 
tart wurde und nicht dte Gefahr eines kistehzusarn- 
menfallens des Robots** bestaod. ... 

Das erfindungsgemfifle Verfahren kann nicht 
nur bei Qblichen Regstetrukturen, sondem auch bei 

35 Bnrichtungen wie Zustandsregler mit Lastmoment- 
beobachter verwendet werden. Die Regeistrukturen 
kOnnen durchaus kaskadiert aufgebaut setn, wobei 
einzelne Regelschleifen fQr Weg, Drehzahl und 
Strom vorgesohen sein kdnrten. 



Anspruche 

1. Bnrichtung zum Kompensieren des Schwer- 
45 krafteinflusses auf ein elektromotorisch heb-und 
senkbares Element einer Werkzeugmaschine oder 
eines Roboters, wobei die FQhrungsgrOfle f Or die 
Bewegung des zugeordneten Antriebs auf diesen 
Qber mindestens einen Regler so einwirkt dafl ats 
so SteHgrOBe ein dem jeweils etnzusteilenden Moment 
des Antriebs entsprechender Strom ausIOsbar 1st 
dadurch gekennzetchnet. dafl der StellgrOfle - 
(Mm) eine SteuergrOfle (M s ) Qberiagerbar ist, die 
ein stQtzendes Gegenmoment zu dem durch die 
55 Schwerkdraft auf das hebund senkbare Element - 
<T1) und damit auf den Antrieb (M) ausgeQbten 
Moment bildet 
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2. Verfahren zum Betrieb einer Elnrichtung 
gemSB Anspruch 1, dadurch getennzeichnet, 
dafl zunSchst ohne SteuergrSfle mit einem unkriti- 
sch eingestelften Regler (R) bei vorgebbaren Lagen 
jeweils ein statischer Zustand eingeregeit wird, daB 
die dabel Jeweils resufflerende StellgreBe registriert 
wird, dai fOr jede dJeser Lagen die Jewells regi- 



strierte StellgrdBe als SteurgrSte (Ms) aufge- 
schattet wird und dai daraufhln der Regler (R) In 
seiner Hnstellung optimiert wird. 

3. Verfahren nach Anspruch 2, dadurch ge- 
$ kennzelchnet, daB nach der Optimiarung des Re- 
glers (R) die Aufschaltung der Steuergr60e (Mg) 
zurOckgenommen wird. 
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